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Abstract 


This paper discusses the development of a linear control algorithm for formations in the vicinity 
of the L2 sun-Earth libration point. The development of a simplified extended Kalman filter is 
included as well. Simulations are created for the analysis of the stationkeeping and various 
formation maneuvers of the Stellar Imager mission. The simulations provide tracking error, es- 
timation error, and control effort results. For formation maneuvering, the formation spacecraft 
track to within 4 meters of their desired position and within 1.5 millimeters per second of their 
desired zero velocity. The filter, with few exceptions, keeps the estimation errors within their 
three-sigma values. Without noise, the controller performs extremely well, with the formation 
spacecraft tracking to within several micrometers. Each spacecraft uses around 1 to 2 grams of 
propellant per maneuver, depending on the circumstances. 


INTRODUCTION 

NASA would like to fly many distributed 
spacecraft missions in the next decade and beyond. 
Among these concepts, the Magnetospheric Multiscale 
and Magnetospheric Constellation^ will study the mag- 
netotail of the earth, Stellar Imager^ (SI), MAXIM^, and 
Constellation-X^ will image stars and black holes re- 
spectively, and the Laser Interferometer Space An- 
tenna^ (LISA) will attempt to detect gravitational 
waves. Some of these missions, including SI and 
MAXIM, plan to operate near the Sun-Earth libration 
poirjts, and have very precise formation control re- 
quirements. 

Farquhar*^ initially examined control tech- 
niques for the station-keeping of satellites orbiting a 
libration point. Gomez, Masdemont, and Simo^ have 
extensively studied dynamics and control problems 
involving libration points. Scheeres and Vinh® have 
researched the dynamics and control of relative motion 
of two spacecraft in unstable orbits. Hoffman^ and 
Wie‘^ used the linear quadratic regulator to control 
problems involving the Earth-Moon collinear libration 
points. Currently, diverse approaches to support these 
mission types are under study. In this paper, the use of 
high fidelity dynamics along with a discrete linear- 


quadratic-regulator framework is applied for control of 
SI in the vicinity of the L2 Sun-Earth libration point. 
The development of a simplified extended Kalman fil- 
ter is included as well. 

ST MISSION DESIGN AND CONTROL 
REQUIREMENTS 

SI is a concept for a space-based, UV-optical 
interferometer, proposed by Carpenter and Schrijver^V 
The purpose of the mission is to view many stars with a 
sparse aperture telescope in an attempt to better under- 
stand the various effects of stars’ magnetic fields, the 
dynamos that generate them, and the internal structures 
and dynamics of stars. The leading concept for SI is a 
500-meter diameter Fizeau-type interferometer com- 
posed of 30 small drone satellites that reflect incoming 
light to a hub satellite. The hub will recombine, process, 
and transmit the information back to Earth. As Figure 1 
shows, in this concept, the hub satellite lies halfway 
between the surface of a sphere containing the drones 
and the sphere origin. Focal lengths of both 0.5 km and 
4 km are being considered. This would make the radius 
of the sphere either 1 km or 8 km. Details of the re- 
quired formation geometry may be found in the appen- 
dix. 

The type of orbit and location in space is an 
important part of mission design. The best orbit choice 
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for the formation after consideration of gravity gradi- 
ents, scattered and stray light, and element replacement 
is a Lissajous orbit around the Sun-Earth L2 point. The 
y-amplitude of the Lissajous orbit will be about 
600,000 km, but is not critical to the mission. With this 
orbit, SI will be able to cover the entire sky every half 
year while maintaining an aim perpendicular to the sun. 
For useful imaging, SI must aim within 10 degrees of 
perpendicular from the sun. 


Drones 



To function properly, SI will need to accom- 
modate a wide range of control functions. In addition 
to maintaining its desired trajectory around L2, the 
formation must slew about the sky requiring movement 
of a few kilometers and attitude adjustments of up to 
180 degrees. While imaging, though, the drones must 
maintain position within 3 nanometers of accuracy in 
the direction radial from the hub and within 0.5 milli- 
meters of accuracy along the sphere surface. The accu- 
racy required for attitude control while imaging is 5 
milli-arcseconds tip and tilt (rotations out of the surface 
of the sphere). The rotation about the axis radial from 
the hub (rotation within the sphere) is a much less strin- 
gent 10 degrees. 

To achieve these requirements, Leitner and 
Schnurr*^ propose a three-tiered formation control ap- 
proach. The first tier is “rough” control using radio 
frequency (RF) ranging and modified star trackers for 
sensors and thrusters for actuators. The relative posi- 
tions will be controlled to within a few centimeters. 
This level will drive lost-in-space emergencies, forma- 
tion initialization, large translations due to formation 
slewing, collision avoidance, and maintenance of the 
formation’s trajectory about L2. The RF ranging sys- 
tem will provide range measurements, and the modified 
star trackers will provide azimuth and elevation meas- 
urements. The actuators for this tier will be four low- 
thrust, high specific impulse (Isp) thrusters. The thrust 
level will be on the Newton to milli-Newton order of 
magnitude. It is this tier that this paper primarily ad- 
dresses, although these results could be applied at the 
next tier as well. 


The second tier is “intermediate” control with 
a modulated laser ranging system as sensors and thrust- 
ers as actuators. The relative positions will be con- 
trolled to within 50 microns at this tier. This level will 
drive primary attitude adjustments and small translation 
maneuvers. Twelve 10-100 micro-Newton Indium 
Field Emission Electric Propulsion (FEEP) thrusters 
will be used for this level. This propulsion technology 
is currently available, but by 2015 should be vastly im- 
proved. Basically, this tier functions to smooth the 
transition from the rough control of the first-tier to the 
fine precision control of the third-tier. 

The third-tier is fine precision control. At this 
level, the satellites themselves will not move; instead, 
the optics will be adjusted by extremely accurate me- 
chanical devices with an accuracy in the nanometer 
range. Rather than having a traditional sensor to deter- 
mine measurements, phase diversity and wave-front 
error (WFE) sensing algorithms, using data from the 
incoming light rays, will determine the needed control. 
Currently, phase diversity and WFE sensing are in their 
infancy for use with spacecraft and formation flying 
concepts. 


Controller Development 

A common approximation in research of this 
type models the dynamics of a satellite in the vicinity of 
the sun-earth L2 point using the circular restricted 
three-body assumptions. These assumptions only ac- 
count for gravitational forces from the sun and Earth. 
The moon is also included, but not as an independent 
body. The masses of the earth and moon are combined 
and assumed to be at the earth-moon baryc enter. The 
motion of the sun and the earth-moon barycenter is also 
assumed to be circular around the system barycenter. 

This analysis uses high fidelity dynamics 
based on a simulation named Generator that Purdue 
University has developed. Generator creates much 
more realistic Lissajous orbits than those derived from 
the circular restricted three-body problem. Using 
ephemeris files, Generator takes into account the effects 
of eccentricity, an independent moon, the other planets 
of the solar system, and solar radiation pressure. The 
resulting Lissajous orbit can then be used as a more 
accurate reference orbit. In addition to providing the 
reference positions and velocities. Generator also nu- 
merically computes and outputs the linearized dynamics 
matrix, /I, for a single satellite at each epoch. This data 
can be used onboard for autonomous computation by 
simple uploads or onboard computation as a back- 
ground task of the 36 matrix elements and the state 
vector. A Generator reference orbit is shown in Figure 
2. The origin in Figure 2 is the earth. The X coordinate 
connects the two primary bodies, the Z coordinate is 
parallel to their angular velocity of the system, a), and 
the V coordinate completes a right-handed system. The 
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reference orbit period is 359 days and the scale is in 
kilometers. 



Figure 3. Generator based 359 day reference orbit 
around Lz 


The coordinates of a satellite can be written as 


X = + X 

(1) 

r = Vo+y 

(2) 

Z = Zg + Z , 

(3) 

where Xg, Xq , and Zg are the coordinates of any one 
of the libration points. The linearized equations of mo- 

tion about a collinear point can be expressed 
space notation as 

in state- 

II 

X 

(4) 

where 


X = [x y z X y z\ , 

(5) 

and A is output from Generator. 


For SI, the overall formation must follow a 

prescribed path about the libration point, and individual 
satellites must maintain desired relative configurations; 

i.e. the controller must be of the tracking type, 
the state error as 

Define 

X(0 = X(0-X,e/(0, 

(6) 

SO that the desired linear control law is 


1 

II 

s 

(7) 

The problem is therefore in the form of the linear- 
quadratic -regulator (LQR), which provides the gain K 

that minimizes the cost 

function 

J = j{x^(r)fFx(r) + u^(r)l^u(T)}c?r 

(8) 

'0 

where IF is a penalty on the mean square tracking er- 

rors, and F is a penalty on the control energy. 

Assum- 

ing the reference satisfies the state differential equation. 

the closed loop dynamics are 



(9) 


where u is the control vector and B is the matrix that 
maps the control effort to the state-space. The control 
is modeled as ideally applied acceleration in the x, y, 
and z directions. Therefore, 


0 0 0 
0 0 0 
0 0 0 
1 0 0 
0 1 0 
0 0 1 


and 


u 


( 10 ) 


where Wj is the control in the x direction, U 2 is the 
control in the y direction, and W 3 is the control in the z 


direction. 


Letting subscript I denote the hub, the con- 
troller will regulate the hub to follow a desired path 
around L2, while the drones, denoted by higher sub- 
scripts, will be controlled relative to the hub only. Thus 
the drone’s state vectors are actually relative to the hub, 
not the libration point, and for satellite 2 , the tracking 
error obeys 

^2 =A\2 +5U2 (11) 

For the complete formation, it is convenient to redefine 
A and B such that 
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The system is discretized using a sample-and-hold ap- 
proach. The state transition matrix is created from the 
dynamics partials output from Generator by 

*=0 

truncating the series after the quadratic term. Although 
the A matrix from Generator is slowly time-varying, it 
is assumed to be constant over the time step, which is in 
all cases much smaller than the “period” of the Lissa- 
jous orbit. At each time step, the steady-state LQR 
control gain is computed from the solution of the dis- 
crete algebraic Riccati equation corresponding to the 
state transition matrix for that epoch. 

Since the measurements are critical to the fea- 
sibility of the SI control concept, and since the types of 
measurements under consideration are nonlinear in the 
states of the controller described above, a simplified 
extended Kalman filter that uses the dynamics de- 
scribed above, augmented by zero-mean, white, Gaus- 
sian process and measurement noise was also studied. 
The discretized state dynamics for the filter are 
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(14) 

where w is the random process noise vector. The (non- 
linear) measurement model is 

y*="'(xj+v (15) 

The covariances of process and measurement noise are 

e\ww^ \= Q , e\vv^ \= R , (16) 

For the hub, we assume Earth-based range, 
azimuth, and elevation, are measured. To keep the fil- 
ter simple, the angles were assumed to be measured in 
relative to the ecliptic plane. 

For the drone satellites, positions are deter- 
mined relative to the hub satellite. Range is a scalar, so 
whether it comes from a sensor on the hub or the drone 
is unimportant. Azimuth and elevation, on the other 
hand, usually come from sensors on the drone space- 
craft. They are in the frame of reference of the local 
coordinate system centered on the drone. Because the 
states of the drone spacecraft are represented with re- 
spect to the hub spacecraft, and the angles are with re- 
spect to the drone spacecraft, a coordinate transforma- 
tion is required. However, if the local coordinate sys- 
tem on the drone is oriented the same as the reference 
coordinate system on the hub (b| is aligned with x, b2 is 
aligned with y\ and is aligned with z), the position of 
the drone can be determined from simple trigonometry. 

For convention positive azimuth is defined as 
counter-clockwise from the b2 direction in the bpb2 
plane. Positive elevation is defined from the bi-b2 
plane upwards in the positive b3 direction. The position 
of the drone relative to the hub is then 

x = r cos(el) sin(az), (17) 

z = -rsin(^/), (18) 

where r is the range, el is the elevation, and az is the 
azimuth as shown in Figure 3 . 



Figure 3 . Range, azimuth, and elevation 
of one spacecraft 


In terms of the states, the measurements for one satellite 
are 


/-=^x +y +z^ (19) 

el = sin“^( — ), and az = sin~‘( )(20) 

r rcos(e/) 

These models are used with standard techniques, e.g. as 
may be found in Brown and Hwang to construct the 
simplified extended Kalman filter for this study. 

RESULTS 


Three different scenarios make up the position 
control problem — maintaining the Lissajous orbit, 
slewing the formation to aim at another star, and recon- 
figuring the formation to take another snapshot of a star 
when necessary. These three scenarios are treated in- 
dependently. To determine the amount of fuel, the ve- 
locity change, or AF, is needed. The AK in each 
direction is found by numerical integration: 

=Sk|7-. (21) 

*=l t=l 

where T is the maneuver interval, the upper limit of the 
sum is the simulation length. The absolute value of the 
control is taken because the direction of the maneuver 
has no bearing on the fuel used. The total for one 
simulation is calculated by 

AF = AF, +AF^-hAF^ (22) 

Lissajous Orbit Maintenance 

Following the Lissajous orbit is not a problem 
of formation control, but rather a problem of maintain- 
ing an orbit. Therefore, only the hub satellite needs 
simulation to determine the amount of control and fuel 
needed to maintain a Lissajous orbit. The results can be 
extended similarly to other satellites in the formation. 

The continuous state weighting matrix and the 
continuous control weighting matrix are chosen to be 


le 6 

\eb 


w = 


\eb 

le3 


le3 

Ie3 



(23) 


The values of the process and the measurement noise 
covariance matrix for the hub satellite are chosen to be 
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0 



0 


0 1* 

0 

/? = 

f T 

le-6 


l,1500000j 

le-6 


f “ T 

If -6 


U 500000 j 


(24) 


The strength of the process noise is set at a 
value large enough to be noticed, but not so much as to 
constrict or destabilize the system. The first term in the 
measurement noise covariance matrix assumes range 
measurements from the earth to the hub within 0. 1 km 
or 100 meters. The second and third terms assume that 
the arc lengths corresponding to the azimuth and eleva- 
tion angles are three times less accurate than the range 
measurements. To find the angular accuracy, simply 
divide the accuracy of arc length by the range. The Li 
point is approximately 1.5 million kilometers from the 
earth and is used as a roughly constant scaling distance. 

The measurement covariance for the drone 
satellites is different from that of the hub: 


0 . 000 1 ’ 





(25) 


Here, the range measurement is assumed to be accurate 
to within 0. 1 meters, with three times less accurate arc 
lengths. The range from the hub to the drones is the 
focal length of the interferometer (either 0.5 or 4 km). 


The initial covariances for the hub and drones are 

(26) 


'1 


oor 

1 


,001' 

1 


oor 

86 4' 


0864' 

864' 


0864' 

864' 


0864' 


respectively. For the hub, this assumes about 1 km 
accuracy for position (10 times greater than measure- 
ment noise covariance) and 1 meter per second for ve- 
locity. The 86.4 term is the conversion to kilometers 
per day from meters per second. For drone satellites, 
the covariance corresponds to a position accuracy of 1 
m and velocity accuracy of 1 millimeter per second. 
Figure 4 shows the tracking errors plotted against time 
for a simulation one year, with a time step of 1 day. The 
plots on the left are position tracking errors, and the 
plots on the right are velocity tracking errors. Running 
many simulations, it can be seen that the steady-state 
position tracking errors are within 0.25 km for each 
direction, and the steady-state velocity tracking errors 
are within 7.5e-4 meters per second for each direction. 
Because the estimation errors are based on randomness, 
many simulations must be run to determine useful re- 


sults. Figure 5 shows the estimation errors of a dozen 
simulations. 


hub tracking error 



time (days) {days} 

Figure 4. Hub tracking errors 

The plots on the left are the position estimation 
errors, and the plots on the right are the velocity esti- 
mation errors. The blue lines represent the actual esti- 
mation errors, and the red lines represent the three- 
sigma value of the covariance. 
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Figure 5. Hub estimation errors (12 simulations) 


The estimation errors lie within the three- 
sigma values of the covariance with very few excep- 
tions. The position estimation errors are within 250 
meters, and the velocity estimation errors are within 
2e-4 meters per second. Figure 6 shows the control 
effort over the course of one simulation. Averaging the 
determined AV from a dozen simulations, the AV 
required to keep a satellite in a Lissajous orbit about L2 
for 359 days is approximately 0.38 meters per second. 
Using the rocket equation, and Stellar Imager of initial 
spacecraft mass of 550 kg for the hub, a 100 kg for a 
drone, and the Isp for the low-thrust, high-Isp thruster 
of 10000 seconds, the amount of propellant needed to 
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Formation 


maintain a Lissajous orbit for 359 days is less than 2.2 
grams for the hub and less than 0.4 grams for each 
drone. 


Conlrol 1 
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Figure 7. SI formation before and after 90 degree slew 
(0.5 km focal length) 


Figure 6. Hub control effort 

Formation Slewing 

A key part of the SI mission is to image many 
stars. Following a Lissajous orbit around L2, SI could 
view the entire sky approximately every half-year while 
slewing about Just the radial (x) axis. This will also 
maintain the aiming angle perpendicular to the sun. 
The formation slewing simulation follows a similar 
algorithm as the Lissajous orbit simulation. 

For this simulation, the maneuver interval is I 
minute and the length of the simulation is 24 hours, 
using a constant ^-matrix from day 2 of the year-long 
simulation made above. Various slew angles are ex- 
amined. All other tuning parameters are the same, ex- 
cept that their discretized values are adjusted by the 
change in time step. The strength of the process noise 
is different from the Lissajous orbit simulation, 

• ' 1 ( 27 ) 


As before, the strength of the process noise is set at a 
value large enough to be noticed, but not so much as to 
constrict or destabilize the system. 


The hub tracking error, estimation error, and 
control are found for focal lengths of both 0.5 and 4 
km. Each drones’ tracking error, estimation error, and 
control are determined as well. For conciseness, only 
the results for one drone will be shown (satellite 2). 
Two slewing angles are investigated, 90 degrees and 30 
degrees. Figure 7 provides an image of the entire SI 
formation slewing 90 degrees, with a 0.5 km focal 
length. 


The black dots represent drones at the beginning of the 
simulation, and the open circles represent drones at the 
end of the simulation. The hub is the black asterisk at 
the origin. The upper-right plot illustrates the 
Golomb^^ rectangle formation projected into the x-z 
plane. The lower-left plot clearly shows the drones 
slewing 90 degrees about the hub-centered x axis. 

Figures 8 and 9 show the tracking errors for 
the hub and drone. Although the plots are specific to a 
90 degree slew with a 0.5 km focal length, they are 
qualitatively representative of all the different slew an- 
gle and focal length scenarios. 


hub Iracking errof 



lime time 

Figure 8. Hub tracking error (90 degree slew and 0.5 
km focal length) 

For both 90 degree and 30 degree slews with 
either a 0.5 or 4 km focal length, the hub tracks to 
within 50 meters of its reference position and to within 
5 millimeters per second of its desired velocity. The 
drones all track to within 3 meters of their desired ref- 
erence positions and to within 1 millimeter per second 
of their desired zero velocities. 
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drone 2 tracking error 
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Figure 9. Drone 2 tracking error (90 degree slew and 
0.5 km focal length) 



Figure 10. Hub estimation error for 0.5 km focal length 
and 90 degree slew 


Table 1 lists the total position tracking error 
after one day for the different scenarios when noise is 
turned off. 


Table 1. Formation slewing position tracking errors 
with no noise 


Focal 

length 

(km) 

Slew 

angle 

(deg) 

Hub 
position 
tracking 
error (m) 

Drone2 
position 
tracking 
error (m) 

Drone 3 1 
position 
tracking error 
(m) 

0.5 

90 

8.33e-6 

3.075e-6 

3.075C-6 

0.5 

30 

3.05e-6 

1.126e-6 

1.126e-6 

4 

90 

7.35e-5 

2.713e-5 

2,713e-5 

4 

30 

2.69e-5 

9.93e-6 

9.93e-6 


For all scenarios, neglecting noise, the velocity 
tracking error is essentially zero after one day. If noise 
is turned off, the tracking errors go asymptotically to 
zero, as expected with a linear quadratic regulator con- 
trol strategy. Clearly, the noise and estimation errors 
have a significant effect on the tracking errors. 

Figure 10 shows the estimation error results of 
a dozen simulations for the hub with varying slew an- 
gles and focal lengths. The red lines are the three-sigma 
values. The hub’s steady-state position three-sigma 
values are about 50 meters, and the steady-state veloc- 
ity three-sigma values are about I millimeter per second 
for all scenarios. The estimation errors are within the 
three-sigma values with few exceptions. The three- 
sigma values change for each simulation (because the 
noise is random), but the change cannot be seen for the 
hub because the order of magnitude of change is much, 
much less than their overall value. 

Figure 11 shows the estimation errors for a 
dozen simulations for the first drone satellite. Drone 2’s 
estimation errors are, with few exceptions, within the 
three-sigma values for all scenarios. 


- IQ-* Drone ZEE x 10^ 



lime (min) i‘fTie (mir>) 

Figure 11. Drone 2 estimation errors for 0.5 km focal 
length and 90 degree slew 

The three-sigma value change from one simulation to 
another can be seen in the drone estimation error plots. 
The range from the hub to the drone is either 0.5 or 4 
km, whereas the range from the hub to the earth is 
about 1.5 million km. 

From the control efforts, the directional AV 
can be determined as before but the time interval of 
1440 minutes must be taken into account. The total 
AV is found from the directional AV ’s. The differ- 
ences between slewing AV s and orbit maintenance 
A F s are the number of maneuvers over the course of 
the simulation and the maneuver interval. The forma- 
tion slewing simulation runs for one day, with one ma- 
neuver per minute (1440 maneuvers), whereas the Lis- 
sajous orbit simulation runs for 359 days with one ma- 
neuver per day. Table 2 shows the average AV 's for a 
dozen simulations for the various scenarios. 
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Table 2 Average formation slewing 's 


Focal 

Slew 

Hub 

Drone 2 

Drone 3 1 

Length 


Angle 

(deg) 

AF (m/s) 

AV (m/s) 

AV (m/s) 

0.5 

30 

1.0705 

0.8271 

0.8307 

0.5 

90 

1.1355 

0.9395 

0.9587 

4 

30 

1.2688 

1.1 189 

1.1315 

4 

90 

1-8570 

2.1907 

2.1932 


The larger the angle the formation slews 
through, the more AF is needed. Also, the larger the 
focal length, the more AV required. Table 3 shows 
the corresponding propellant masses needed to achieve 
the AF ’s given in Table 2, with the assumptions that 
the Isp of the low-thrust thrusters is 10000 seconds, the 
initial mass of the hub is 550 kg, and the initial mass of 
each drone is 100 kg. 


Table 3. Average formation slewing propellant masses 


Focal 

Slew 

Hub 

Drone 2 

Drone 3 1 

Length 

(km) 

Angle 

(deg) 

f^prop (g) 

"fprop (g) 

'"prop (g) 

0.5 

30 

6.0018 

0.8431 

0.8468 

0.5 

90 

6.3662 

0.9577 

0.9773 

4 

30 

7.1135 

1.1406 

1.1534 

4 

90 

10.4112 

2.2331 

I 2.2357 


When the noise is turned off, the required 
A F and propellant mass is reduced significantly. Ta- 
ble 4 shows the AF ’s and Table 5 shows the corre- 
sponding propellant masses when noise is removed. 


Table 4. Required AF ’s for formation slewing cases 
without noise 


Focal 

Length 

(km) 

Slew 

Angle 

(deg) 

Hub 

AF (m/s) 

Drone 2 
AV (m/s) 

Drone 3 1 
AF (m/s) 

0.5 

30 

0.0504 

0.0853 

0.0998 

0.5 

90 

0.1581 

0-2150 

0.2315 

4 

30 

0.4420 

0.5896 

0.6441 

4 

90 

1.3945 

1.9446 

1.9469 


Table 5. Required propellant masses for formation 
slewing cases without noise 


Focal 

Slew 

Hub 

Drone 2 

Drone 3 1 

Length 

(km) 

Angle 

(deg) 

'"prop (g) 

'"prop (g) 

'"prop (g) 

0.5 

30 

0.2826 

0.0870 

0.1017 

0.5 

90 

0.8864 

0.2192 

0.2360 

4 

30 

2.4781 

0.6010 

0.6566 

4 

90 

7.8182 

1.9822 

1.9846 


Formation Reorientation 

For some stars, one snapshot from the SI for- 
mation will not provide enough sampling data for suffi- 
cient resolution. In these cases, the drones must rotate 
90 degrees and take another snapshot. The aim from 


the drones, through the hub, to the desired star, is 
maintained with such a reorientation. Figure 12 shows 
the first four drones of the formation before and after 
reorientation (with a 0.5 km focal length). Only four 
drones are pictured for clarity. 


Formation Reorientation 




Figure 12. Formation reorientation (0.5 km focal 
length) 

The scale is in kilometers in all four pictures. 
The plot in the upper-right shows the projection of the 
formation in the x-z plane. The black dots are the 
drones at their initial conditions, and the open circles 
are the drones after the simulation. The formation ap- 
pears to have rotated clockwise 90 degrees about the y 
axis, but the hub is into the page, so the rotation is 
counterclockwise when viewed from the hub. Figures 
13 and 14 show the tracking errors for the hub and the 
drone for the 0.5 km focal length case. 


hub tracking error 



lime time 


Figure 13. Hub tracking error (0.5 km focal length) 


The hub tracks to within 40 meters of its reference po- 
sition, and to within 8 millimeters per second of its ref- 
erence velocity for both focal lengths. 
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drone 2 Iracking error 



time i*fne 

Figure 14. Drone 2 tracking error (0.5 km focal length) 

Every drone tracks to within 4 meters of its reference 
position, and to within 1 .5 millimeters per second of its 
desired zero velocity for both focal lengths. 

When noise is turned off, the satellites track 
much better than when the noise is included. Table 6 
shows the total position tracking errors for the various 
satellites after one day, when noise is eliminated. 


Table 6. Formation reorientation position tracking 
errors with no noise 


Fcx:al length 
(km) 

Hub position 
tracking 
error (m) 

Drone 2 
position 
tracking 
error (m) 

Drone 3 1 
position 
tracking error 
(m) 

0.5 

2.l47e-6 

0.792e-6 

0.793e-6 

4 

2.l46e-6 

0.792e-6 1 

0.793e-6 


The tracking errors go asymptotically to zero, 
and the velocity tracking errors are essentially zero at 
the end of a day. Just as with the formation slewing 
simulation, the noise, and in turn the estimation errors, 
are the largest reason for imperfect tracking. 

Since the hub and drone estimation errors for a 
dozen simulations with the different focal lengths is 
similar to the slew simulations, they are not shown 
here. The steady-state x three-sigma value is about 30 
meters. The steady-state y and z three-sigma value is 
about 50 meters. The steady-state velocity three-sigma 
values are about 1 millimeter per second. The hub es- 
timation errors stay within the three-sigma values ex- 
cept for rare occasions. For any drone and either focal 
length, the steady-state position three-sigma values are 
less than 0.1 meters, and the steady-state velocity three- 
sigma values are less than le-6 meters per second. 
Also, the estimation errors stay within the three-sigma 
values with rare exceptions. 

The AF can be determined, for each satellite, 
from the control effort required to reorient the forma- 


tion. Table 7 gives the average AF ’s from a dozen 
simulations to reorient the formation. 


Table?. Average formation reorientation AF 's 


Focal Length 
(km) 

Hub 

AF (m/s) 

Drone 2 
A F (m/s) 

Drone 31 
AF (m/s) 

0.5 

1.0126 

0.8421 

0.8095 

4 

1.0133 

0.8496 

0.8190 


The focal length has no discernible effect on the AF 
needed to reorient the formation. This makes sense 
because the rotation is about the y-axis, and the focal 
length is assumed to be the measurement along the y 
axis from the hub to the drones. Table 8 gives the pro- 
pellant masses that correspond to Table 7. 


Table 8. Average formation reorientation propellant 
masses 


Focal Length 

Hub 

Drone 2 

Drone 3 1 

(km) 

f»prop (8) 

fftprop <g) 

f^prop (g) 

0.5 

5.6771 

0.8584 

0.8252 

4 

5.6811 

0.8661 

0.8349 


Without noise, the AF needed to reorient the 
formation is much less, as shown in Table 9. 


Table 9. Required A F for formation reorientation 
without noise 


Focal Length 
(km) 

Hub 

AF (m/s) 

Drone 2 

AV (m/s) 

Drone 3 1 
AF (m/s) 

0.5 

0.0408 

0.1529 

0.1496 

4 

0.0408 

0.1529 

0.1495 


Table 10 gives the propellant masses that correspond to 
Table 9. 


Table 10. Required propellant masses for formation 
reorientation without noise 


Focal Length 

Hub 

Drone 2 

Drone 3 1 

(km) 

"tpn>p (8) 

'ftprop (8) 

^prop (g) 

0.5 

0.2287 

0.1623 

0.1525 

4 

0.2287 

0.1623 

0.1524 


SUMMARY AND CONCLUSION 
The control strategy and Kalman filter pro- 
vided satisfactory results. The hub satellite tracks to its 
reference orbit sufficiently for the SI mission require- 
ments. The drone satellites, on the other hand, track to 
only within a few meters. Without noise, though, the 
drones track to within several micrometers. The first 
tier of the proposed control scheme for SI requires the 
drones to track within centimeters. This could be ac- 
complished with better sensors to lessen the effect of 
the process and measurement noise. Tuning the con- 
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troller and varying the maneuver intervals should pro- 
vide additional savings as well The Kalman filter per- 
formed such that the estimation errors were for the most 
part within the three-sigma values. The propellant mass 
and AF results provide a minimum design boundary 
for the SI mission. Additional propellant will be 
needed to perform all attitude maneuvers, tighter con- 
trol requirement adjustments, and other mission func- 
tions. 

Future studies must examine the attitude dy- 
namics and control problem and integrate this into the 
translation control. Other items that should be consid- 
ered in the future include; non-ideal thrusters, collision 
avoidance, system reliability and fault detection, and 
nonlinear control and estimation. For the nanometer 
level preciseness of the second and third control tiers, 
new control strategies and algorithms may be required. 
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Appendix; SI Formation Geometry 

The hub spacecraft is assumed to be at the 
center of a sphere, on which the drones lie. The x di- 
rection of the hub-centered Cartesian coordinate system 
is parallel to and in the same direction as the radial axis 
of the earth-centered rotating coordinate system used by 
Generator. The y direction of the hub-centered system 
is parallel to and in the same direction as the along- 
track direction of the earth-centered system. The z di- 
rection of the hub-centered system is parallel to and in 
the same direction as the cross-track direction of the 
earth-centered system. Figure 14 shows the relation- 



Figure 14. Hub-centered Cartesian coordinate system 

The drones’ positions are expressed in the spherical 
coordinates, r, 0, and (f> , which relate to the hub- 
centered Cartesian coordinates by 
X = r sin(0) , y = r cos(^) sin(^) , (la) 

and z = r cos(^) cos(<^ ) (2a) 

The radial coordinate, r, is the distance from 
the hub to the drone and always equals the radius of the 
sphere, which is twice the desired focal length. The (f> 

coordinate is measured from the positive z axis toward 
the positive y axis. Standing on the positive x axis and 
looking back, a positive rotation is clockwise. The 6 
coordinate is measured from the position in the y-z 
plane along the sphere in a clockwise direction when 
considered from the positive z axis looking back. 

Initially, the center of the formation will be 
placed directly behind the hub in the along-track direc- 
tion. Thus, 
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^cen, = 0 and = 


3/r 


(3a) 


where 6^^^^ and are initial coordinates corre- 

sponding to an imaginary central drone satellite. There 
are 30 drones for the SI mission, so 15 have a co- 
ordinate greater than , and 15 have a coordi- 
nate less than . Knowing that the maximum dis- 
tance between drones is 0.5 km, or 0.25 km to the 
imaginary central drone, the coordinates can be calcu- 
lated by 

17-/ . _,r0.25' 

-sin 


T I T ccn 


(4a) 


15 \ r , 

where i represents the 2”^ through 1 6*^ satellite (the hub 
being number 1), and 

'0.25' 


-- — !^sin' 

r t Tcent | ^ 


(5a) 


where i represents the 17'*' through 31^' satellite. The 
0” coordinates can be determined in a similar fashion, 
for i from 2 to 3 1 , 

'0.25^ 


e? 


■ ^rer,l + — Sio 

15 


(6a) 


where j is an integer between -15 and 15, such that 
each satellite, i, has a unique j. This formation is a 
Golomb^' rectangle laid out on a spherical surface 
rather than a plane. The spherical coordinates for each 
drone and the imaginary central drone are intermedi- 
ately transformed to Cartesian coordinates yielding 

and z°. Finally, 






int ^0 


cent 


0 

y cent ■ 


the satellites are translated by half of the imaginary 
central coordinates to account for the hub being half- 
way between the origin of the sphere and the surface of 
the sphere: 


0 ini ^0 
X; = X; 


and 


0 0 
^cent 

^ ^yi ~ yi ^ 


0 int ^ 0 

Z; = Z; 


0 

7 

“cent 


(7a) 


(8a) 


^ cent 


cent 


These spherical reference coordinates used to yield the 
intermediate X- , y,- , z,- , x^^^j , , and 

^7lnt ' drones must be translated by half of the 

imaginary central drone position: 


jef ref 

r ^ 

^cenl 

(12a) 

.. - JC,. 

2 

fef^int ref 
i ^ i 

J cent 

2 

(13a) 

jef _inl^re/ 

z'^ 

^ cent 

(14a) 


The drones initially start with zero relative velocity to 
the hub, so for i from 2 to 3 1 , 

i-=T-=z-=0, (9a) 

Two types of maneuvers are considered in this 
paper; slews and reorientations. In a slew, the reference 
states are built by rotating the formation through a slew 
angle, a . The rotation is about the hub-centered x 
axis. Thus, for i from 2 to 3 1 , 

(10a) 

«,l=C,=o <>>») 


No relative velocities between the hub and drones are 
desired, so for i from 2 to 3 1, 

if =yf =zf =Q. (15a) 

The drones’ reference states do not change over the 
course of the simulation. 

The hub satellite’s initial and reference condi- 
tions are treated differently than the drones’, because 
the hub’s reference states change over the duration of 
the simulation. From Generator, the hub reference con- 
ditions are known at the beginning of the simulation, 

xf°, and at the end of simulation, one day later, 
^rcfend reference states at some epoch, k, 

during the simulation are determined by linear interpo- 
lation. 

The development for the formation reorienta- 
tion is nearly identical to the formation slewing simula- 
tion. The difference between the formation reorienta- 
tion and formation slewing simulations is the desired 
reference states of the drones. The formation slewing 
reference states are based on a variable slew angle, a , 
rotation about the x axis, whereas the formation reori- 
entation reference states are based on a 90 degree rota- 
tion about the y axis. The imaginary central drone has 
the same reference conditions as initial conditions, 

Setting 


for i from 2 to 31, gives the drones’ reference positions. 
The rotation is 90 degrees counterclockwise about the y 
axis when looking back from the hub. Once again, zero 
relative velocity between the drones and the hub is de- 
sired. 


2k 

T’ 

cent 

- oL. = 0 

(17a) 


ef 


(19a) 
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